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NOTICES 



JPO and NCIPI are not responsible for anydamages caused by the use of this 
translation. 

1 This document has been translated by computer. So the translation may not 

reflect the original precisely. 

2.**** shows the word which can not be translated. 

3. In the drawings, any words are not translated. 



CLAIMS 



(57) [Claim(s)] 

[Claim 1] 1st means to determine or correct the desired value about either of the 
movement magnitude in the a. aforementioned robot's stairway rise and fall, and 
the migration direction at least in the control device of the leg formula mobile 
robot of a 2-pair-of-shoes walk, It has 2nd means to detect the relative relation 
between the b. aforementioned robot and a stairway. And said 1st means The 
control unit of the leg formula mobile robot characterized by being that by which 



I 

t 

said 2nd means is based on said relative relation detected by n steps of 
arbitration, and determines or corrects said the n+1st step of desired value as 
follows. 



DETAILED DESCRIPTION 

[Detailed Description of the Invention] 
[0001] 

[Industrial Application] When this invention more specifically goes up and down 
a stainA/ay about a mobile robot's control unit, it relates to the thing which 
enabled it to move to a landing location also in the environment where constraint 
is received at stability and a high speed. 
[0002] 

[Description of the Prior Art] Conventionally, as a technique about a mobile robot, 
robots, such as a wheel type, a crawler type, and a leg formula, are proposed. In 
it, as a thing about a leg formula mobile robot's control technique The technique 
about the robot of 1 piece () [ Raibert, M.H., Brown, Jr.H.B., ] [ "Experiments in 
Balance With a 2D One-Legged Hopping ] Machine", ASME, J of DSMC, vol.106, 
pp.75-81 (1984), The technique about the robot of 2 pieces (203 Robotics 



Society of Japan vol.1, no. 3, pp.167- 1983), The technique about the robot of 4 
pieces (643 9 Robotics Society of Japan vol. no. 5, pp.638- 1991), The 
technique about the robot of 6 pieces () [ Fischeti, M.A., and "Robot Do the Dirty 
Work" IEEE, spectrunn, vol.22.no.4, ] [ pp.65-72(1985).Shin-Min ] Song and 
Kenneth J. Waldron, "Machines That Walk;The Adaptive Suspension Vehicle", 
TheMIT Press Much Cambridge(s) and Massachusetts(es) are proposed, 
furthermore, the technique (Shimoyama -) which generates a stable migration 
(walk) pattern dynamically on real time by the robot of a low degree of freedom 
comparatively The volume "dynamic walk of a 2 pairs of bamboo horse mold 
bipedal robot", and on Japan Society of Mechanical Engineers collected-works C, 
The 48th volume. No. 433, pp.1445-1454. 1982.. and "Legged Robots on Rough 
Terrain; Experiments in AdjustingStep Length", by Jessica Hodgins.lEEE and 
1988, The technique (JP,62-97006,A, JP,63-150176,A) which generates a 
stable migration (walk) pattern is also comparatively proposed off-line by the 
robot of many degrees of freedom. Moreover, these people have also proposed 
the control unit of a 2-pair-of-shoes bipedal robot by Japanese Patent 
Application No. No. 336420 [ two to ] etc. previously. 
[0003] 

[Problem(s) to be Solved by the Invention] By the way, when a mobile with a 
discrete landing location moves the environment where constraint is received to 



a landing location like a leg formula mobile robot (for example, when going up 
and down a stairway etc.), it is necessary to control a landing location careful. 
That is, if a crawler bearing area utilizable in order that the relative position of a 
robot and a stairway may maintain back past ** and stability becomes small, a 
position becomes unstable and a relative position passes a front conversely in 
case a leg formula mobile robot goes up a stairway, as shown in drawing 13 , 
when moving to the next stage, **** will interfere and the stability of a position 
will be broken down similarly. Thus, when landing locations, such as a stairway, 
move the environment where constraint is received, it is necessary to control the 
relative position of a robot and a stairway. 

[0004] Moreover, in relation to this, some things which control **** to land on a 
target position at accuracy are proposed conventionally. For example, the 
technique walked by the so-called guide-peg probe which searches a landing 
location and determines a control value is proposed, attaching a non-contact 
type ultrasonic sensor, a contact type touch sensor, etc. at the head of a guide 
peg, and processing a detecting signal frequently. Moreover, that around which 
he is walked so that it may become as the value with which a robot's actual step 
(gait) was designed by control which suppresses an oscillation of a robot's foot 
etc. is also proposed. Although such technique is based on the idea which is 
going to prevent beforehand generating of the relative-position error of a robot 



and a actual stairway, since it walks detecting a landing location by **** when 
based on the former technique, when walking speed cannot be gathered and it is 
based on the latter technique, there is inconvenience from which the control unit 
of high performance is needed, and a control configuration becomes 
complicated. 

[0005] Therefore, the object of this invention is to offer the control unit of a 
mobile robot comparatively simple also as a control configuration while it is the 
stable position and can be moved to a high speed, also when mobile robots, 
such as a leg formula robot, move the environment where constraint is received 
in migration, such as a stairway. 
[0006] 

[Means for Solving the Problem] In order to solve the above-mentioned technical 
problem, this invention is set to the control unit of the leg formula mobile robot of 
a 2-pair-of-shoes walk, as shown for example, in claim 1 term. 1st means to 
determine or correct the desired value about either of the movement magnitude 
in said robot's stairway rise and fall, and the migration direction at least, And it 
had 2nd means to detect the relative relation of said robot and stairway, and said 
1st means was constituted so that said 2nd means might be based on said 
relative relation detected by n steps of arbitration and might determine or correct 
said the n+lst step of desired value as follows. 



[0007] 

[Function] Since it is based on said detected relative relation and said the n+1st 
step of desired value as follows was detemiined or corrected by n steps of 
arbitration, accumulation of a relative-position error can be prevented, and 
though it is a simple configuration, it can move to a high speed with the position 
stabilized also when moving an environment with constraint. 
[0008] 

[Example] Hereafter, taking the case of the robot of a 2-pair-of-shoes walk, the 
example of this invention is explained as a leg formula mobile robot. Drawing 1 is 
explanation skeleton drawing showing the robot 1 on the whole, and equips the 
leg link 2 of each right and left with six joints (the electric motor which drives It 
shows each joint for the facilities of an understanding). To the order from a top. 
the joints of these six individuals are the joints 10R and 10L (right-hand side is 
set to R and left-hand side is set to L.) for leg winding of the waist. Below The 
same joints 12R and 12L of the pitch direction (it rotates to the circumference of 
a X axis) of the waist. The joints 14R and 14L of this roll direction (it rotates to the 
circumference of the y-axis), the joints 16R and 16L of the roll direction of a knee 
region, While being the joints 18R and 18L of the roll direction of a guide-peg 
neck, and the joints 20R and 20L of this pitch direction and attaching **** (foot) 
22R and 22L in the lower part, a case (base) 24 is formed in the most significant, 



and a control unit 26 is stored in the interior. 

[0009] In the above, a waist joint consists of joint 10R (L), 12R (L), and 14R (L), 
and an ankle joint consists of joint 18R (L) and 20R (L). Moreover, it is the thigh 
links 32R and 32L between a waist joint and a knee joint, and is connected by 
the leg links 34R and 34L between a knee joint and an ankle joint. Here, the leg 
link 2 can give six degrees of freedonn about a guide peg on either side, 
respectively, and it can give the movement toward a request to the whole guide 
peg, and it consists of driving these 6x2=12 piece joints (shaft) at a respectively 
proper include angle during a walk so that three-dimension space can be walked 
to arbitration. Although it has the reducer which the above-mentioned joint which 
stated previously consists of an electric motor like, and doubles the power that 
output further, since that detail is given to the application (Japanese Patent 
Application No. No. 324218 [ one to ], JP,3-184782,A) which these people 
proposed previously and it is not just going to consider in itself as the summary 
of this Invention, the explanation beyond this Is omitted. 

[0010] In the robot 1 which shows drawing 1 , well-known 6 axial-tension sensor 
36 is formed in a guide-peg neck, the force components Fx, Fy, and Fz of x, y, 
and the direction of z transmitted to a robot through **** and the moment 
components Mx, My, and Mz of the circumference of the direction are measured, 
and the existence of landing of a foot, the magnitude of the force of joining a 



support saddle, and a direction are detected. Moreover, it is extensively stuck on 
it in the shape of a matrix, many touch sensors 38 being covered with a 
protective coat 380 by the rear face of ****22R (L) as shown in drawing 2 . A 
touch sensor 38 is well-known, conductive rubber material is included, and if 
****22R (L) contacts a floor line and crushing of the conductive rubber material is 
carried out, electric resistance will change. A touch sensor 38 is connected to 
the processing circuit 39. Drawing 3 is the explanatory view show the detail of 
the processing circuit 39, and the output of a touch sensor 38 is send to the 
sensor actuation control section 390 as an analog value, respectively, a sensor 
output group is scan [ then, ] to a perpendicular direction and a horizontal 
direction by well-known technique, and it is measure with the threshold of a 
multiple value, and is output to the image processing section 391 as a video 
signal of the value according to the configuration of an object where synthesized 
the comparison result and ****22R (L) contacted, and a degree of hardness. In 
the image-processing section 391, it collates with a storing database and the 
configuration and contact location of the contactant are detected. Furthermore, 
the dip sensor 40 is installed in a case 24, and the inclination to the z-axis within 
a x-z flat surface, the angular velocity and an inclination [ similarly as opposed to 
the z-axis within a y-z flat surface ], and its angular velocity are detected to it. 
Moreover, the rotary encoder which detects the rotation is prepared in the 



electric motor of each joint. Furthermore, although omitted in drawing 1 , the 
zero switch 42 for amending the output of the dip sensor 40 and the limit switch 
44 for the cure against fail are formed in a robot's 1 proper location. These 
outputs are sent to the control unit 26 in the above mentioned case 24. 
[001 1] Drawing 4 is the blocl< diagram showing the detail of a control unit 26, and 
consists of microcomputers. In there, the output of the dip sensor 40 etc. is 
changed into digital value with A/D converter 50, and the output is sent to 
RAM54 through a bus 52. Moreover, while the output of the encoder which 
adjoins each electric motor and is arranged is inputted in RAM54 through a 
counter 56, a touch sensor output is similarly stored for the output of a zero 
switch etc. in RAM54 through an input circuit 59 through a waveform shaping 
circuit 58. In the control unit, the 1st and 2nd arithmetic unit 60 and 62 which 
consists of a CPU is formed, and like the after-mentioned, the 1st arithmetic unit 
60 computes a target joint include angle by reading the gait parameter stored in 
ROM64, and sends it out to RAM54. Moreover, like the after-mentioned, the 2nd 
arithmetic unit 62 reads the desired value and the detected actual measurement 
from RAM54, and outputs it to the electric motor which computes a control value 
required for actuation of each joint, and drives each joint through D/A converter 
66 and a servo amplifier. 

[0012] Then, actuation of this control unit is explained. 



[0013] Although drawing 5 is a flow chart which shows actuation of this control 
device, before starting that explanation, the description of this invention is 
explained below with reference to drawing 6 . 

[0014] If it puts in another way as that premise when several steps of rise and fall 
are possible even if this invention does not control the relative position of a robot 
and a stairway, the range which can be walked to the relative position of a robot 
and a stain/vay will exist, and it will consider the case where the relative-position 
error generated in the rise and fall which are one step is small. It enabled it to go 
up and down a stain^^ay continuously by not performing control for landing **** 
on a target position in this invention at accuracy, since it thinks [ that it is actually 
such in many cases and ], but performing control which prevents that this 
relative-position error accumulates, and controlling within limits with the walk 
possible in which which described the relative position of a robot and a stairway 
above, although it approves that a relative-position error occurs in one step of 
arbitration. Since It can be gone up and down at a high speed compared with the 
above mentioned conventional technique since this invention does not need to 
detect the location of a stairway using ****, and it does not need the control unit 
of high performance so much, it becomes simple constituting it. 
[0015] Drawing 6 is control-block drawing in the example of this invention. A 
target landing location (desired value) and U (z) S (z) by a diagram A step 



command value (control input), A real landing location (controlled variable) and 
E (z) Y (z) A relative-position error (system deviation), In an integral element and 
(1/z), 1 sampling lag unit and K (z) express a control device, and, as for delta (z), 
G (z) expresses [ disturbance and I (z) ] the pulse transfer function from a robot's 
(controlled system) step command value to a real step. These relation comes to 
be shown in several 1 and several 2. 



[0016] 
[Equation 1] 
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[0017] 



[Equation 2] 
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[0018] Temporarily, for simplification, Gain k, then conditions for stability show G 

(z) to Gain g, and come to show control unit K (z) to several 3. 

[0019] 



[Equation 3] 
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[0020] Moreover, if the die length of a stairway is fixed at L (shown in drawing 7 ), 
since a target position will change in the shape of a step, the steady-state 
deviation over this comes to be shown in several 4, and is converged on 
constant value according to k, g, and L. 
[0021] 
[Equation 4] 
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[0022] Similarly, the steady-state deviation over the disturbance of the shape of 
an impulse of magnitude D and step-like disturbance comes to be shown in 
several 5 and several 6, and is converged on constant value according to 0, or k, 
g and D. 
[0023] 
[Equation 5] 
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[0024] 



[Equation 6] 
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[0025] What is necessary is just to determine Gain k so that it may be promptly 
completed by the relative-position error generated according to disturbance etc. 
and steady-state deviation may be settled in tolerance. Furthermore, if control 
unit K (z) is constituted so that an integral element may be included, steady-state 
deviation over step-like desired value and step-like disturbance can be set to 0. 
[0026] In the example, G (z) was first identified as gain g. Drawing 8 expresses 
x(n)/u (n) with a histogram. Although he wanted to identify G which does not 
include the effect of disturbance (z), i.e., g, originally, since detection of w (n) 
was difficult, it identified from x(n)/u (n). Since it is presumed that what is 
depended on disturbance is large as for the factor of the skirt being large, it does 
not become a big problem as gain about G (z). Since the core of distribution was 
1 .02, it was thought that it was good also as g= 1 .02, but it was referred to as g= 



1.06 in order to evaluate to an insurance side. Control unit K (z) is made into 
Gain k. Conditions for the control system at this time to become stability are set 
to 0< k<1.89 (**2/g) from several 3 formulas. From several 4 formulas etc., k set 
to k= 0.5 or 0.75, in order that steady-state deviation might avoid that the 
property of a control system becomes in oscillation although it becomes small 
and the larger one might give allowances to gain. Moreover, the result when not 
performing this control for a comparison is shown in drawing 9 . In the case of k= 
0.5, drawing 11 of drawing 10 is the case of k= 0.75. The die length of the 
stairway which each went up and down is 280mm. When not performing this 
control so that clearly from drawing 9 , a relative-position error will increase 
almost linearly and it will exceed 20mm in the 3 to 4th step. On the other hand, 
as for it, the result of having performed this control turns out [ which were shown 
in drawing 10 and drawing 1 1 ] like that a relative-position error is not emitted but 
is converged on about 1 constant value. It is converged as about 10mm by the 
case of k= 0.5, and the case of k= 0.75 is converging the relative-position error 
on about 7.5mm. Since it is set to 7mm as g= 1.02 at the time of 11mm and k= 
0.75 at the time of k= 0.5 according to several 4 formulas, the result of an 
example is seen theoretically and it turns out that it is appropriate. 
[0027] With reference to the drawing 5 flow chart, actuation of this control unit is 
explained on the assumption that the above. 



[0028] First, each part of equipment is initialized by S10, and it progresses to 
S12, and loads from ROM64 which described the gait parameter above there. In 
this example, a robot's gait is beforehand designed in consideration of dynamic 
stability conditions, and is memorized by ROM64 as a gait parameter This gait 
parameter is expressed in a **** target landing location etc. Then, if it progresses 
to S 14, a start signal is stood by and a start signal arises, it progresses to S16, 
and a counter will be incremented, and it will progress to S18, and will judge 
whether it is gait correction timing. About this, it mentions later. 
[0029] Then, a position parameter is calculated by progressing to S20. Since this 
has some which need a interpolation operation in the above mentioned gait 
parameter, it calculates the position parameter of the time of day which asks for 
it here and is specified with the counter of S16. Then, unless progress to S22, 
and calculate the include angle of 12 joints and it progresses to S24, and stand 
by a synchronizing signal, outputs the joint include angle computed by having 
progressed to S26 in the place which was able to take the synchronization, it 
progresses to S28 and it is judged as walk termination, while returning to SI 6 
and repeating the same activity, when judged as termination, it progresses to 
S30, and a counter is reset and it finishes. That is, the loop formation of S16 to 
S28 is carried out to every [ of the counter of S16 ] unit time amount (for example, 
20ms). Moreover, although servo control is performed-like in parallel according 



to the flow chart shown in drawing 12 in the 2nd arithmetic unit 62 described 
above so that it might become that joint include angle based on the joint include 
angle outputted by S26, since this activity is well-known, explanation is omitted. 
[0030] In the procedure so far, a robot reproduces and walks a stable gait on the 
dynamics target designed beforehand. Moreover, control for maintaining the 
stability of a walk against disturbance is also performed simultaneously. 
However, the explanation about stabilization control is omitted here. It can go up 
and down a stairway until a relative-position error is accumulated and it 
separates from a robot by the described technique by the above from the range 
which can walk a relative position. In this example, when die length went up and 
down the general stairway which is 280mm, the range which can walk the above 
mentioned relative-position error was influenced by **60mm, and an 
environment and disturbance, but on the average, since the relative-position 
error generated in per rise and fall of one step of stairway was about 5 to 10mm, 
it has gone up and down succeeding ten-step order. 

[0031] Here, although it was judged in the drawing 5 flow chart whether it is gait 
correction timing in SI 8, the event of a foot carrying out bed leaving in this 
control was made into gait correction timing. Since having considered timing 
which detects a relative-position error as the time of bed leaving in this example 
can correct a **** orbit using between [ whole ] swing phases if a relative-position 



error is detected before bed leaving and it feeds back to a target landing location, 
while modification that it is not rapid and smooth is attained and being able to 
suppress lowering of the stability of a gait to the minimum, it is because the 
newest relative-position error can be used for control in time. 
[0032] And when judged as the time of bed leaving by S18, it progresses to S32, 
when the robot has gone up and down the stairway, the touch sensor 38 
arranged at ****22R (L) detects the edge of a stairway for every step, and a 
relative-position error with a stairway is detected as compared with the target 
position of the edge indicated in the gait parameter. Then, the target landing 
location which it does not accumulate according to the relative-position error 
which progressed to S34 and was detected and which determines the suitable 
amount of target step corrections like, progresses to S36 continuously, and is 
indicated in the gait parameter is rewritten. Updating of a target landing location 
specifically changes a step from the gait with which a robot's gait was designed 
beforehand. For example, by +20mm, as for 0.5, then the step of one step as 
follows, the relative-position error in the stage of arbitration may be 280mm(die 
length of stainA^ay)-(20mmx0.5) =270mm so that clearly [ gain ] from drawing 7 . 
And since the landing location of ****22R (L) is determined by the revolution of 
the circumference of x, y, the directions of z, and those shafts, those all or parts 
are corrected so that it may become the changed step. If the above procedure is 



repeated for every step during stairway rise and fall, accumulation of a 
relative-position error can be prevented and any number of steps can go up and 
down continuously. 

[0033] Although a gait shall be beforehand designed in consideration of dynamic 
stability conditions and it shall memorize in ROM64 as a gait parameter here, it 
is an aim that a robot's degree of freedom solves the stable problem beforehand, 
and makes the burden of the computer during a walk light from there being many 
amounts of operations for solving a dynamic stability problem by 12 pieces, and 
it is also one description. As a result of having solved the stable problem, a 
robot's waist location or center-of-gravity location is memorized as time series 
data together with the gait parameter. In connection with changing in said 
procedure, while walking a target landing location, a waist location or a 
center-of-gravity location must also be changed. Here, by this example, although 
the dynamic stability problem could be solved again and the waist or a 
center-of-gravity location could be determined, in order to maintain the above 
mentioned aim, the technique of correcting the time series data of the waist 
indicated in the gait parameter or a center-of-gravity location was used. 
Furthermore, since it enabled it to correspond even if it changes a landing 
location and a direction into arbitration in three-dimension space, the waist or a 
center-of-gravity location was corrected using the technique described below. 



Since the waist, or a center-of-gravity location and the final amount of 
corrections of a direction is equal to a landing location or the amount of 
corrections of a direction, the final waist, a center-of-gravity location, or a 
direction can be found by the coordinate transformation of a parallel 
displacement or a rotation. Similarly, a transitional location and a transitional 
direction can also be searched for by coordinate transformation. At this time, it is 
made to continue to acceleration and the amount of corrections of a waist 
location is gradually changed so that the amount of corrections used as a 
parameter of coordinate transformation may be suddenly changed neither into a 
landing location nor the amount of corrections of a direction but it may be in 
agreement in a landing location or the direction at the time of day which lands. A 
waist location etc. can be corrected without spoiling greatly the stability of the 
gait designed beforehand according to the correction technique of of this waist 
location and direction. Furthermore, since a robot's dynamic stable problem has 
strong nonlinearity, lowering of stability can be suppressed to the minimum by 
using not the pattern of simple acceleration continuation but the acceleration 
continuation pattern in consideration of a robot's property which can be 
described, for example by the 5th polynomial. The landing location was 
correctable in this example to **50mm at once with this technique, maintaining a 
robot's position at stability. 



[0034] Since it was made to make correction timing only the time of a foot 
carrying out bed leaving paying attention to a walk of a robot not failing if the 
relative-position error accumulated this example and it did not exceed tolerance 
like the above Since it avoided detecting a landing location and the location of 
**** frequently and correcting a control value frequently when putting in another 
way, a robot's walking speed can be gathered as compared with the case where 
the location of a stain^^ay is detected using **** stated with the conventional 
technique. Moreover, when controlling to control an oscillation of a foot etc. and 
to become a target step, even if it compares, the control unit of high performance 
is not needed so much, but a configuration becomes simple. 
[0035] In addition, whenever the foot carried out bed leaving in the 
above-mentioned example S18 of the drawing 5 flow chart, the gait was 
corrected according to the error, but a gait may be corrected only when the 
accumulated of the detected error comes to exceed tolerance. Moreover, it is 
good also as correction timing of a gait with events other than bed leaving. 
[0036] Moreover, although the example applied like when [ for which its foot is 
not missed on a stairway ] a landing location was controlled to a cross direction 
explained in the above-mentioned example When walking like as the path 
(travelling direction) on which its foot is not missed to a longitudinal direction like 
when [ at which its foot otherwise is not missed when you walk on 1 . sleeper ] 



you walk on 2. rail and which was ordered with 3. straight line, the polygonal line, 
a curve, etc., 4. When going up and down 5. spiral staircase so that it may arrive 
and pass at the time of day set to the target point or the passage point, to a 
discrete thing, a parameter to control cannot ask ** which is a direction as it is a 
location, but can be widely adapted. Moreover, when going up and down a spiral 
staircase, it can apply also to the case where there are two or more discrete 
control parameters simultaneously. 

[0037] Moreover, although only the example of a 2-pair-of-shoes walk leg 
formula mobile robot was shown, appropriate is carried out also to the leg 
formula mobile robot of 1 pair of shoes, and it carries out appropriate similarly in 
the leg formula mobile robot of 3 more or more pairs of shoes. In the case of 3 or 
more pairs of shoes, when a landing position error is corrected whenever the 
guide peg carried out bed leaving about each guide peg, or the total value of the 
error of each guide peg exceeds tolerance, the landing position error of one of 
guide pegs or all guide pegs will be corrected. Furthermore, if a landing location 
is the mobile restrained discretely, it will carry out appropriate not only in a leg 
formula mobile robot. 

[0038] Moreover, although the **** touch sensor was used for detection of a 
landing position error in the above-mentioned example, it is not restricted to it 
and various detection means, such as an ultrasonic sensor, an optical sensor. 



and a visual sensor, may be used. 

[0039] 

[0040] 

[0041] 

[0042] 

[Effect of the Invention] If it is in claim 1 term, it sets to the control unit of the leg 
formula mobile robot of a 2-pair-of-shoes walk. 1st means to determine or 
correct the desired value about either of the movement magnitude in said robot's 
stairway rise and fall, and the migration direction at least, It has 2nd means to 
detect the relative relation of said robot and stairway. And said 1st means Since 
it constituted and carried out so that said 2nd means might be based on said 
relative relation detected by n steps of arbitration and might determine or correct 
said the n+lst step of desired value as follows While being able to move to a 
high speed with the position stabilized also when accumulation of a 
relative-position error was able to be prevented though it was a simple 
configuration, and the leg formula mobile robot of a 2-pair-of-shoes walk went up 
and down a stairway, desired value can be determined the optimal, controlling 
lowering of the stability of a gait to the minimum (correction). 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is the schematic diagram, showing the control device of the mobile 
robot concerning this invention on the whole taking the case of the leg formula 
mobile robot of a 2-pair-of-shoes walk, 

[Drawing 2] it is the explanatory view showing the touch sensor attached there 
with the bottom view of **** of the robot of drawing 1 . 

[Drawing 3] It is the block diagram showing the processing circuit of the touch 
sensor of drawing 2 . 

[Drawing 4] It is the explanation block diagram of the control unit shown in 
drawing 1 . 

[Drawing 5] It is the flow chart which shows actuation of the control unit of 
drawing 4 . 

[Drawing 6] It is the block diagram showing the landing location amendment 
control of the control of the drawing 5 flow chart. 

[Drawing 7] It is the explanatory view showing rise-and-fall actuation of the 
stairway planned by drawing 6 . 

[Drawing 8] It Is the histogram which shows the gap property of a actual landing 
location over the target landing location at the time of stairway rise and fall of the 



robot which shows drawing 1 . 

[Drawing 9] It is experimental data drawing showing the error of the target 
landing location when going up and down a stairway, without a robot with the 
property shown in drawing 8 performing control by this invention, and a actual 
landing location. 

[Drawing 10] It is experimental data drawing showing the error of the target 
landing location when a robot with the property shown in drawing 8 performing 
control by this invention, and going up and down a stairway, and a actual landing 
location. 

[Drawing 11] It is another experimental data drawing showing the error of the 
target landing location when a robot with the property shown in drawing 8 
performing control by this invention, and going up and down a stairway, and a 
actual landing location. 

[Drawing 12] It is the flow chart which shows the activity which carries out servo 
control of the joint include angle determined and outputted by the drawing 5 flow 
chart to desired value. 

[Drawing 13] It is the explanatory view in which a leg formula mobile robot shows 
the condition of going up and down a stairway. 
[Description of Notations] 

1 Leg Formula Mobile Robot (2-Pair-of-Shoes Bipedal Robot) 



2 Leg Link 

10R, 10L Joint for leg winding 

12R, 12L Joint of the pitch direction of the lumbar part 
14R, 14L Joint of the roll direction of the lumbar part 
16R, 16L Joint of the roll direction of a knee region 
18R, 18L Joint of the roll direction of a guide-peg neck 
20R, 20L Joint of the pitch direction of a guide-peg neck 
22R, 22L **** (foot) 
24 Case (Base) 
26 Control Unit 
38 Touch Sensor 
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